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(54) Method and device for detecting and locating obstacles in a vehicle environment. 

(57) The invention relates to a method for detecting and locating obstacles in a vehicle environment. To this 
effect, it comprises the steps of emitting signals in the direction of said environment from a plurality of radars 
(2) on the vehicle, deducing from the echo signals received the probability of occupancy, by an obstacle, of a set 
of elementary cells (9) of said environment, and combining the probabilities relative to each set of cells. 
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Method and device for detecting and locating obstacles in a vehicle environment 

The present invention relates to a method and a device for detecting and locating obstacles located in 
the environment of a vehicle, whether stopped or moving. 

An important function of mobile robotics relates to the detection of objects or obstacles located in front 
of, or to the side of, a carrier vehicle, because these objects may interfere with its movement and must 
be avoided, or may' require that the vehicle be stopped completely for safety concerns, or, on the other 
hand, may be sufficiently distant or in a direction such that the vehicle can continue its path without 
making a detour. 

A secondary aspect of this detection consists in taking advantage of a priori knowledge about the 
(absolute) position of the object detected in relation to a map or a larger site, so that, by detecting this 
object and measuring its coordinates (location and distance), it is possible to deduce information about 
the absolute position of the vehicle itself. 

A convenient means for detecting objects located in the periphery of a vehicle, and for making it 
possible to measure their coordinates, consists in using ultrasound sensors. 

According to this proven technology, an acoustic wave is emitted periodically and, because it is 
reflected by the objects that constitute obstacles to its propagation, comes back to the sensor after a 
delay time, which is directly dependent on the distance of the object thus detected. 

To ensure the peripheral detection of a vehicle, it is advantageous to have a sufficient number of such 
sensors located along its circumference, depending on the aperture angle of the elementary sensor. This 
number is higher the narrower the detection lobes of the sensors are. 

The use of these sensors provides information on distance in relation to an obstacle, but the 
information on angular orientation becomes poorer as the width of the lobe of the sensors increases: 
Indeed, to the extent that a sensor sees a given object not in one point of space, but in an ambiguous 
manner, at all points located at an equal distance, if several sensors are associated to ensure coverage 
of the perimeter of the vehicle, the uncertainty of the angular position of the obstacles detected may be 
excessively large. 

On the other hand, finer detection requires a greater number of elementary sensors with narrower 
lobes, which increases the overall cost of the detection. 

Another drawback for the use of ultrasound sensors is their great sensitivity to external acoustic 
disturbances, to reflection anomalies on certain obstacles, as well as the sensitivity of the sound waves 
to wind, where the echo can even be blown away and never come back to its source. 

The present invention aims to overcome these drawbacks. 

To this effect, the invention relates, first of all, to a method for detecting and locating the obstacles 
located in the environment of a vehicle, characterized in that it comprises the steps of emitting signals 
in the direction of said environment from a plurality of radars on the vehicle, deducing from the echo 
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signals received the probability of occupancy, by an obstacle, of a set of elementary cells of said 
environment, and combining the probabilities relative to each set of cells. 

Algorithms for the combination of information are already known in the art. However, the fact of 
combining probabilities of occupancy of elementary cells, wherein these probabilities themselves are 
obtained from radar signals, can yield, with the technique according to the invention, results that are 
quite surprising on account of their precision, which even allows for the mapping of the obstacles 
detected, thus making it possible to avoid them, as well as for the localization of the vehicle itself, 
because of the high quality of the modeling of the environment that is thus achieved. 

Moreover, unlike ultrasound sensors, radars can be used outdoors and in any kind of weather. 

Finally, it has been observed that the invention even enables the use of radars with relatively mediocre 
individual performance, without altering the results of the overall modeling. 

In one embodiment of the invention, the combination is done on the basis of the probability values 
provided by a plurality of radars, and specifically by two radars. 

In this case, the combination is done spatially, so as to associate the data simultaneously returned by a 
subset of radars that have detected the same obstacle at different angles. > 

In another embodiment, the combination is done on the basis of the probability value supplied by one 
radar and the probability value previously known for the same cell. 

In this case, the combination is done temporally, because the same obstacle is seen successively by the 
same sensor, which has moved forward at the same time as the vehicle. In this case, the combination 
operation is applied to the value already assigned to the cell. 

From the signals received as echoes it is possible to deduce information on distance and angular 
information about the obstacles, and to determine the said probabilities of occupancy from these items 
of information. 

Preferably, a step is provided for setting a threshold for the results of the combination, so as to obtain a 
map stripped of any miscellaneous artifacts that might originate from specular or multiple reflections 
of the radar waves emitted. 

According to one particular embodiment of the invention, the signal emitted by the radars is frequency 
modulated; the signal received as an echo is mixed with a fraction of the emitted signal so that, after 
the carrier frequency is eliminated, a beat signal is formed; and the beat pulses are counted for a pre- 
determined interval in order to provide the distance of an obstacle. 

As a variation, this distance can be derived via a Fourrier [sic] transform. 

Advantageously, the emission of each radar lasts for a limited time and the repetition logic can even be 
coded for the purpose of identifying the source. 
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The invention likewise relates to a device for modeling the environment of a vehicle, characterized in 
that it comprises a plurality of radars mounted on the vehicle and a processing unit equipped to 
combine the data provided by the radars. 

Thanks to the combination operation, it is possible, without disadvantage, to select radars with a wide 
lobe, and thus with average performance and low cost. 

It will be observed that radars of this type, particularly current Doppler radars, are generally used to 
measure speed, while, here, it is mainly distance that is measured, while speed may be measured 
merely in an accessory manner. Moreover, while the radars used to measure distances are generally 
radars functioning with pulses, here preferably continuous emission frequency modulated radars are 
used. 

Now, as a non-limitative example, one particular embodiment of the invention will be described, in 
reference to the annexed diagrammatic drawings, in which: 

- Figure 1 is a diagrammatic view from above of a vehicle equipped with the means according to the 
invention, 

- Figure 2 is a functional diagram of these means, 

- Figure 3 illustrates the signals emitted by the radars, 

- Figure 4 represents the modeling of the environment of the vehicle, 

- Figure 5 illustrates the function of the distribution of the probabilities for the occupancy of a cell by 
an obstacle, as a function of the distance to the focal point of an antenna, and 

- Figure 6 illustrates the function of the distribution of the probabilities of occupancy of this cell as a 
function of the angular deviation between its direction and the axis of the antenna. 

Figure 1 represents an automatic vehicle equipped with a platform 1, on which are mounted a plurality 
of radars 2, about twenty, for example. The radars 2 here are radars with a wide lobe, in other words, 
with an aperture angle 29 of typically 15° to 120°. It should be recalled that a large angle 29 is sought 
to obtain good peripheral coverage around the vehicle with as few sensors as possible. 

The radars 2 here are FMCW radars with frequency modulation and continuous emission or emission 
in a temporal window. 

The radars 2 are placed on the periphery of the vehicle so as to obtain a vision of its environment that 
is as complete as desired. The fineness of the detection coverage and of the modeling in general is 
directly dependent on the number of radars used, and their individual lobes may converge arbitrarily, 
as represented, toward the front (arrow 3) and the side of the vehicle. 

Figure 2 shows radar antennas 2a, 2b, and 2c. Each of these antennas is connected by means of an 
interface circuit 4a, 4a, 4c, respectively, to a unit 5 capable of producing the trigger signals Sa, Sb and 
Sc respectively of the radars. As a variation, the trigger signals may be common to all the radars. 
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The signals Sa, Sb, Sc are frequency modulated, as represented in Figure 3. A carrier frequency Fp is 
modulated by a sawtooth wave having a frequency Af. This frequency generation may be carried out at 
the level of unit 5 by a GUNN oscillating diode. 

Optionally, for each signal Sa, Sb, Sc, the modulated emission lasts for a limited time D. This 
facilitates the differentiation of the signals received, as well as the extraction of the information being 
sought. In addition, by coding the logic of the repetition of the emissions, in other words duration T in 
Figure 3, for example, according to a pseudo-random model, it is possible to customize each of the 
emissions. Thus, in particular, it is possible to allow several vehicles to move about in the same 
environment. 

The signal received back by each antenna 2a, 2b, 2c is processed in an analog processing unit 6a, 6b, 
6c respectively. 

The received signal is out of phase in relation to the emitted signal. By mixing in the corresponding 
unit 6 with a fraction of the emitted signal, after the carrier frequency is eliminated, a beat signal with a 
typical frequency in the order of 1 kHz is obtained. 

First of all, the signal is filtered to eliminate the high frequencies, which correspond to the most distant 
obstacles. Thus only the signal that is bounced back by the first obstacle encountered is retained, and it 
is then processed by Fourrier [sic] transform. 

In addition, the comparison of the frequency of the carrier wave that is bounced back and that of the 
carrier wave of the emitted signal yields the Doppler frequency F d , which is proportional to the speed 
at which the vehicle is moving toward or away from the obstacle detected, according to the formula: 

v = 1/2 X F d 

in which X = c/F (speed of propagation / frequency of emission) 

The speed information is not necessary to the implementation of the invention. Its availability, 
however, constitutes an advantage in the applications. 

The digitized distance and speed information is provided by the analog processing units 6a, 6b, 6c to 
the digital processor 7. 

The processor 7 is essentially comprised of a calculating unit capable of accessing a memory 8. 

To each element of the memory 8 there is associated one elementary cell 9 of the environment of the 
vehicle. The content of each one of its memory elements represents the probability that any one 
particular cell, localized by its sight angle <b and its distance d in relation to the vehicle, contains an 
obstacle. 

Figure 4 represents 2 radars 1 1 and 12, each of which has detected an obstacle; the first at distance di 
and the second at distance d 2 . As a convention, it was decided that the probability of occupancy of a 
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cell by an obstacle ranges between -1 (the cell is definitely not occupied) and +1 (the cell is definitely 
occupied), while probability p = 0 corresponds to uncertainty. 

Knowing the focal point of each antenna and also its axis of sight, each cell is assigned a probability of 
occupancy, as a function of the distance at which an obstacle has been detected, of the distance of this 
cell to the focal point of the antenna and of the angular deviation between the axis of sight of the 
antenna and the direction of the cell. By way of example, Figure 5 represents the function of the 
distribution of the probabilities of occupancy of a cell as a function of its distance to the focal point of 
the antenna of radar 1 1, and Figure 6 represents the function of the distribution of the probabilities as a 
function of the angular deviation a between the axis of this antenna and the direction being considered. 
The maximum probability is, of course, found for distance di and in the line of sight of the antenna. 

The different zones of probabilities are displayed in figures 4 through 6. Positive probability zone B in 
Figure 5 [sic] corresponds to two annular bands on either side of the circle with radius di. It is also 
evident from Figure 5 that only the first obstacle encountered is taken into account, because beyond a 
certain distance (zone D), which is a function of di, no information is contributed by the measurement. 
In the same way, in Figure 6, no information is contributed by the measurement outside, the emission 
lobe (zone A). 

The possible levels of quantification between the values -1 and +1 are dependent on the performance 
of the calculation equipment used, with the overall performance of the representation of the 
environment improving, the more of these levels there are. 

Whenever, in this manner, a given cell has been assigned, by the measurement made with the help of 
radar 1 1, a probability pi of occupancy of this cell by an obstacle and, by the measurement made with 
the help of radar 12, a probability p2, the following combination algorithm is implemented: 

- if pi > 0 and p2 > 0 

F(pl,p2) = pl +p2-pl .p2 

- if pi < 0 and p2 > 0 

F(pl,p2) = pl +p2-pl . p2 

- if pi < 0 and p2 < 0 

pi +p2 
F(pl,p2)= 

I -Min (pi, p2) 

This algorithm may be implemented in the manner described above, in other words, spatially, by 
combining the probability information originating from two radars, or else temporally, by using the 
probability information originating from a single radar and by combining it with the probability 
already present in memory 8 for the cell being considered. 
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The probabilities of occupancy of the space are expressed continuously between -1 (cell that is 
definitely empty) and +1 (cell that is definitely occupied). Then a threshold is set for the results of the 
raw combination, so as to obtain a map of the environment of the vehicle, on which the obstacles are 
displayed. 

Moreover, the representation of this map can be improved by subjecting it to a morphological 
"closing" operation (dilation - erosion), known in the field of image processing. 

The map obtained in this way thus provides precise information about the environment of the vehicle 
and makes it possible: 

- for the vehicle to move about while avoiding any possible obstacles; 

- to locate it by comparison between the measured positions of the obstacles and an a priori knowledge 
of these obstacles. 

It is furthermore possible to envision other systems that emit and receive signals other than radar, for 
example, laser or infrared telemeters or sonar systems. 
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CLAIMS 

1. Method for detecting and locating obstacles in the environment of a vehicle, characterized in that it 
comprises the steps of emitting signals in the direction of said environment from a plurality of radars 
(2) on the vehicle, deducing from the echo signals received the probability of occupancy, by an 
obstacle, of a set of elementary cells (9) of said environment, and combining the probabilities relative 
to each set of cells. 

2. Method according to Claim 1, in which the combination is done on the basis of the probability 
values provided by a plurality of radars, and specifically by two radars. 

3. Method according to either one of claims 1 and 2, in which the combination is done on the basis of 
the probability value provided by one radar and the probability value previously known by the same 
cell. 

4. Method according to any one of claims 1 to 3, in which there is deduced, from the signals received 
as echoes, a unit of information on distance and a unit of angular information about the obstacles, and 
said probabilities are determined on the basis of these units of information. 

5. Method according to any one of claims 1 to 4, comprising a step in which a threshold is set for the 
results of the combination. 

6. Method according to any one of claims 1 to 5, in which the signal emitted by the radars is frequency 
modulated; the signal received as an echo is mixed with a fraction of the emitted signal so that, after 
the carrier frequency is eliminated, a beat signal is formed; and the distance from an obstacle is 
obtained by Fourrier [sic] transform or by counting for a pre-determined interval of time. 

7. Method according to any one of claims 1 to 6, in which the emission of each radar lasts for a limited 
time, and the repetition logic is coded for the purpose of identifying the source. 

8. Device for detecting and locating obstacles in the environment of a vehicle, characterized in that it 
comprises a plurality of radars (2) mounted on the vehicle and a processing unit (7) equipped to 
combine the data provided by the radars. 

9. Device according to Claim 8, in which the radars have a wide lobe. 
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Precede et disposltff pour la detection et la localisation cfobstactes dans I'envtronnement d'un vehlcule. 




LTnvention conceme unproo6de de detection et de lo- 
cation d'obstades dans renvironnement d'un vehlcule. 
A cat effet, H comprend les etapes conslstant a 6mettre des 
slgnaux en direction dudit erwfronnement a parrJr d'une plu- 
rality de radars (2) disposes sur le vehlcule, a dedulna des 
slgnaux recus en echo les probability d'occupation par un 
obstacle d'un ensemble de cellules 6l6mentalres (9) dudit 
environnement, et a fuslonner les probability relatives a 
chacune desdites cellules. 
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A 

Proc6d6 et dispositif pour la d6t ction et la localisati n 
d'obstacles dans renvironnement d'un v6hicule 

La presente invention concerne un proced6 et un dispositif pour la detection et 
la localisation d'obstacles situ6s dans renvironnement dun v6hicule arr§t6 ou 
en mouvement. 

Une fonction importante de la robotique mobile concerne la detection des 
objets ou obstacles situes au devant ou sur le cote du vehicule porteur, dans la 
mesure ou ceux-ci peuvent entraver son mouvement et doivent etre 
contournes, ou necessitent son arret complet par souci de securite ou, au 
contraire, sont suffisamment distants ou dans une direction telle que le 
vehicule peut continuer son chemin sans ecart. * 

Un aspect secondare de cette detection consiste a exploiter une connaissance 
a priori du positionnement (absolu) de I'objet detecte par rapport a une carte ou 
un site plus vaste, pour qu'en detectant cet objet et en mesurant ses 
coordonnees (site et distance) on puisse en retirer une information sur la 
position absolue du vehicule lui-meme. 

Un moyen commode pour detecter des objets situes dans la peripherie d'un 
v6hicule et permettant d'en mesurer les coordonnees consiste a utiliser des 
capteurs S ultra-sons. 

Selon cette technologie bien eprouvee, une onde acoustique est emise 
p^riodiquement et, se trouvant reflechie par les objets constituant des 
obstacles a sa propagation, revient vers le capteur apr6s un temps de retard, 
lequel depend directement de la distance de Tobjet ainsi d6tecte. 

Pour assurer la detection peripherique d'un vehicule, il convient de disposer un 
nombre suffisant de tells capteurs sur son pourtour en fonction de Tangle 
d'ouverture du capteur elementaire. Ce nombre est d'autant plus eleve que les 
capteurs auront un lobe de detection etroit 

Utilisation de ces capteurs foumit une information de distance par rapport a 
un obstacle, mais r information d'orientation angulaire est d'autant moins bonne 
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que les capt urs sont d lobe large. En effet, dans la mesur 0C1 un capteur voit 
un obstacle donn6 non pas en un point de I'espace mais de maniere ambigue 
en tous points situ£s a 6gale distance, si Ton associe plusieurs capteurs pour 
assurer la couverture du perim&tre du vehicule, Pindetermination de la position 
5 angulaire des obstacles detectes peut etre excessivement grande. 

A contrario, une detection plus fine exige un nombre superieur de capteurs 
elementaires, a lobes plus etroits, ce qui accroit le cout global de la detection. 

10 Un autre inconvenient de ('utilisation de capteurs a ultra-sons est leur tres 
grande sensibilite aux perturbations acoustiques exterieures, aux anomalies de 
reflexion sur certains obstacles, ainsi que la sensibilite au vent des ondes 
sonores, Pecho pouvant meme etre souffle et ne'jamais revenir a sa source. 

15 La presente invention vise a pallier ces inconvenients. 

A cet effet, P invention a tout d'abord pour objet un procede de detection et de 
localisation des obstacles situes dans Penvironnement d'un vehicule, 
caracterise par le fait qu'il comprend les etapes consistant a emettre des 
20 signaux en direction dudit environnement a partir d'une pluralite de radars 
disposes sur le vehicule, a deduire des signaux regus en echo les probabilites 
d'occupation par un obstacle d'un ensemble de cellules Elementaires dudit 
environnement, et a fusionner les probabilites relatives & chacune desdites 
cellules. 

25 

Des aigorithmes de fusion d'informations sont d6jd connus dans la technique. 
Toutefois le fait de fusionner des probabilites cToccupation de cellules 
elementaires, ces probabilites 6tant elles-memes obtenues a partir de signaux 
radar, peut donner, avec la technique selon Pinvention, des r6sultats tout d fait 
30 surprenants par leur precision, penmettant meme la cartographie des obstacles 
detectes et rendant done possible leur evitement ainsi que la localisation du 
v£hicule lui-m<§me, du fait de la grande quatite de la mod§lisation de 
Penvironnement ainsi effectuee. 

35 Par ailleurs, contrairement aux capteurs a ultra-sons, les radars peuvent etre 
utilises en exterieur et par tout temps. 
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Enfin on a pu constater que I'invention permet meme d'utiliser des radars de 
performance individuelle relativement m6diocre sans alterer les r£sultats de la 
moderation globale. 

5 

Dans un mode de realisation de I'invention, la fusion est effectuee sur les 
valeurs des probabilites fournies par une pluralite de radars, et notamment 
deux radars. 

10 Dans ce cas, la fusion est effectuee de maniere spatiale de maniere a associer 
des donnees retournees simultanement par un sous-ensemble de radars ayant 
detects un meme obstacle sous des angles differents. 

Dans un autre mode de realisation, la fusion est effectuee sur la valeur de la 
15 probability fournie par un radar et la valeur de la probability anterieurement 
connue pour la meme cellule. 

La fusion est dans ce cas effectuee de maniere temporelle, le meme obstacle 
etant vu successivement par un meme capteur qui aura avance en meme 
20 temps que le vehicule. Dans ce cas, I'operation de fusion est appliquee a la 
valeur deja affectee a la cellule. 

On peut deduire des signaux re$us en echo une information de distance et une 
information angulaire sur les obstacles et determiner lesdites probabilites 
25 d'occupation & partir de ces informations. 

De preference on pr6voit une 6tape de seuillage des r6sultats de la fusion de 
maniere a obtenir une carte d&pouillee des artefacts divers pouvant provenir 
de reflexion speculates ou multiples, des ondes radars 6mises. 

30 

Selon un mode de realisation particuliere de Tinvention, le signal 6mis par les 
radars est modu!6 en frequence, le signal re^u en echo est melange a une 
fraction du signal 6rriis pour, apres 6Iimination de la frequence porteuse, former 
un signal de battement, et les impulsions de battement sont comptees pendant 
35 un intervalle pr6d6termin6 pour foumir la distance d'un obstacle. 
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En variante, cett distance peut §tre foumie par transformation de Fourri r. 

Avantageusement, remission de chaque radar dure un temps limits et la 
logique de repetition peut m§me etre cod£e en vue de I'identification de la 
source. 

Uinvention a egalement pour objet un dispositif pour la modelisation de 
Tenvironnement d'un vehicule, caracterisee par le fait qu'il comprend une 
pluralite de radars montes sur le vehicule et une unite de traitement agencee 
pour fusionner les donnees fournies par les radars. 

GrSce a I'operation de fusion, on peut sans inconvenient choisir des radars a 
lobe large, done de performance moyenne et de cout peu eleve. 

On observera que les radars de ce type, notamment les radars Doppler 
courants, sont generalement utilises en mesure de Vitesse alors qu'ici, e'est la 
distance qui est mesuree a titre principal, la mesure de vitesse n'etant 
eventuellement utilisee qu'a titre accessoire. De surcroit, alors que les radars 
utilises en vue de mesures de distances sont generalement des radars 
fonctionnant en impulsions, on utilise ici de preference des radars a emission 
continue et fonctionnant en modulation de frequence. 

On d^crira maintenant a titre tfexemple non limitatif un mode de r6a!isation 
particulier de I'invention, en reference aux dessins schematiques annexes dans 
lesquels : 

- la figure 1 est une vue schematique de dessus d'un vehicule muni des 
moyens de Tinvention, 

- la figure 2 est un diagramme fonctionnel de ces moyens, 

- la figure 3 illustre les signaux 6mis par les radars, 

- la figure 4 repr6sente ia modelisation de Tenvironnement du vehicule, 
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- la figure 5 illustre la fonction de repartition d s probabilit£s d'occupation d'une 
cellule par un obstacle en fonction de la distance au foyer d'une antenne et 

- la figure 6 illustre la fonction de repartition des probabilites cfoccupation de 
5 cette cellule en fonction de I'ecart angulaire entre sa direction et I'axe de 

I'antenne. 

La figure 1 represente un vehicule automatique muni d'une plate-forme 1 sur 
laquelle sont months une pluralite de radars 2, par exemple une vingtaine. Les 
10 radars 2 sont ici des radars a lobe large, c'est-a-dire d'angle d'ouverture 2G 
typiquement compris entre 15° et et 120°. On rappelle qu'un angle 29 important 
est recherche pour obtenir une bonne couverture peripherique autour du 
vehicule avec un nombre de capteurs aussi reduit que possible. 

15 Les radars 2 sont ici des radars FMCW a modulation de frequence et a 
emission continue ou par fenetre temporelle. 

Les radars 2 sont places a la peripherie du vehicule de maniere a obtenir une 
vision aussi complete que desiree de son environnement. La finesse de la 
20 couverture de detection et de la modelisation en general, depend directement 
du nombre de radars utilises dont les lobes individuels peuvent se rejoindre 
arbitrairement comme cela est repesente vers Pavant (fleche 3) et le cote du 
vehicule. 

* 

25 On voit sur (a figure 2 trois des antennes radars 2a, 2b et 2c. Chacune de ces 
antennes est relive par rinterrrukliaire d'un circuit d f inteface 4a, 4b, 4c 
respectivement, a une unite 5 susceptible d'6Iaborer les signaux de 
d6clenchement Sa, Sb et Sc respectivement des radars. En variante, les 
signaux de d6clenchement peuvent etre communs a tous les radars. 

30 

Les signaux Sa, Sb, Sc sont modules en frequence comme represente a la 
figure 3. Une frequence porteuse Fp est modulde par une onde en dent de scie 
de frequence Af. Cette generation de frequence peut etre assur£e au niveau de 
l'unit§ 5 par une diode oscillatrice GUNN. 

35 
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Optionnelt ment, pour chaque signal Sa, Sb, Sc, remission module dure un 
temps limits D. On facilite ainsi la differentiation des signaux regus ainsi que 
I'extraction des informations recherch6es. Par ailleurs, en codant la logique de 
r6p6tition des Emissions, c'est-6-dire la dur6e T sur la figure 3, par exemple 
5 selon un modele pseudo-al£atoire, il est possible de personnaliser chacune 
des emissions. On peut ainsi en particulier faire evoluer plusieurs vehicules 
dans le meme environnement. 

Le signal re?u en retour par chaque antenne 2a, 2b, 2c est traite dans une 
10 unit6 de traitement analogique 6a, 6b ( 6c respectivement. 

Le signal regu est dephase par rapport au signal emis. Par melange dans 
I'unite 6 correspondante avec une fraction du signal emis, apres Elimination de 
la frequence porteuse, un signal de battement & une frequence type de Tordre 
is de 1 kHz est obtenu. 

m 

Le signal est tout d'abord filtre pour eliminer les hautes frequences, 
correspondant aux obstacles les plus eloignes. On ne retient ainsi que le signal 
retrodiffus§ par le premier obstacle rencontre, qui est ensuite traite par 
20 transformee de Fourrier. 

Par ailleurs, la comparaison de la frequence de Ponde porteuse retrodrffusee et 
de celle de Tonde porteuse du signal 6mis donne la frequence Doppler Fd qui 
est proportionnetle a la Vitesse de rapprochement ou d'6loignement du vehicule 
25 de Pobstacle d6tect6, selon la relation : 

v = 1/2 X F d 

ou X = c/F (vitesse de propagation/frequence d*6mission) 

30 • 

L'information de vitesse n'est pas necessaire a la mise en oeuvre de 
('invention. Sa disponibilite constitue neanmoins un avantage dans les 
applications. 

35 Les informations de distance et vitesse num£ris£es sont foumies par les unites 
de traitement analogiques 6a, 6b, 6c au processeur num6rique 7. 
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Le processeur 7 est constitue pour I'essentiel cfune units de calcul susceptible 
d'acc£der & une m 6 mo ire 8. 

A chaque element de la memoire 8 est associee une cellule eiementaire 9 de 
I'environnement du vehicule. Le contenu de chacun de ses elements de 
m<§moire represente la probabilite pour qu'une cellule particuliere, rep6r6e par 
son site <J> et sa distance d par rapport au vehicule, renferme un obstacle. 

La figure 4 represente 2 radars 11 et 1 2 ayant chacun detecte un obstacle, le 
premier a la distance d-| et le second a la distance d2- Par convention, on 
decide que la probabilite d'occupation d'une cellule par un obstacle est 
comprise entre -1 (la cellule est certainement ndn occupee) et +1 (la cellule est 
certainement occupee), la probabilite p = 0 correspondant a I'incertitude. 

Connaissant la position du foyer de chaque antenne ainsi que son axe de 
visee, on affecte a chaque cellule une probabilite d'occupation fonction de la 
distance a laquelle un obstacle a ete detecte, de la distance de cette cellule au 
foyer de I'antenne et de I'ecart angulaire entre I'axe de vis6e de I'antenne et la 
direction de la cellule. A titre d'exemple, la figure 5 represente la fonction de 
repartition des probabilites d'occupation d'une cellule en fonction de sa 
distance au foyer de Tantenne du radar 11, et la figure 6 la fonction de 
repartition des probabilites en fonction de I'ecart angulaire a entre I'axe de 
cette antenne et la direction consideree. La probability maximale est bien 
entendu rencontr£e pour la distance d-| et dans la direction de vis6 de 
rantenne. 

Les differentes zones de probabilit§s sont port6es sur les figures 4 a 6. La 
zone B de probability positive sur la figure 5 correspond a deux bandes 
annulaires de part et d'autre du cercle de rayon d-|. On v6rifie par ailleurs sur 
la figure 5 que seul le premier obstacle rencontrd est pris en compte puisqu'au- 
dela d'une certaine distance (zone D) fonction de d-| aucune information n'est 
apport^e par la mesure. De m<§me sur la figure 6 f aucune information n'est 
apport<§e par la mesure en dehors du lobe Remission (zone A). 
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Les niveaux possibles de quantification entre les valeurs -1 et +1 dependent 
des performances du materiel de calcul utilise, la performance globale de la 
repr6s ntation de I'environnernent 6tant d'autant meilleure que ces niveaux 
sont plus nombreux. 

Lorsque Ton a de cette maniere affecte a une cellule donnee, par la mesure 
effectuee a I'aide du radar 1 1 , une probabilite p1 d'occupation de cette cellule 
par un obstacle et, par la mesure effectuee a I'aide du radar 12, une probabilite 
p2, on met en oeuvre Palgorithme de fusion suivant : 

- si p1 > 0 et p2 > 0. 

F(p1,p2) = p1 +p2-p1.p2 

- si p1 < 0 et p2 > 0 

F(p1.p2) = p1 +p2 + p1.p2 

- si p1 < 0 et p2 < 0 

p1 +p2 

F(p1,p2)= 

1-Min(p1 ( p2) 

Cet algorithme peut etre mis en oeuvre de la fagon decrite ci-dessus, c'est-a- 
dire spacialement, en fusionnant les informations de probability provenant de 
deux radars, ou encore de maniere temporelle, en utilisant Pinformation de 
probability provenant d'un seul radar et en la fusionnant avec ia probabilite 
d6ja pr6sente pour la cellule consideree dans la m§moire 8. 

Les probabilites d'occupation de I'espace s'expriment continument entre -1 
(cellule certainement vide) et +1 (cellule certainement occupee). On realise 
ensuite un seuillage des resultats de la fusion brute de manifere a obtenir une 
carte de I'environnernent du v6hicule sur laquelle sont port6s les obstacles. 
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On peut d'ailleurs am6liorer la representation de cette carte en lui faisant subir 
une operation morphologique de type 'Yermeture" (dilatation * 6rosion), connue 
dans le domaine du traitement d'image. 

5 La carte ainsi obtenue fournit ainsi une information precise sur Tenvironnement 
du vehicule et permet : 

- son evolution avec evitement eventuel d'obstacles ; 

10 - sa relocalisation par comparaison entre les emplacements mesures des 
obstacles et une connaissance a priori de ces obstacles. 



15 



On peut par ailleurs envisager d'autres systemes emetteurs-recepteurs de 
signaux que le radar, par exemple de telemetres laser ou infrarouge ou des 
sonars. 
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* 

REVENDICATIONS 

1. Proc6de de ddtection et de localisation d'obstacles dans Penvironnement 
d'un v6hicule, caracterisd par le fait qu'il comprend les 6tapes consistant a 

5 6mettre des signaux en direction dudit environnement a partir tfune plurality de 
radars (2) disposes sur le vehicule, a d£duire des signaux re?us en 6cho les 
probabilites d'occupation par un obstacle d'un ensemble de cellules 
elementaires (9) dudit environnement, et a fusionner les probabilites relatives a 
chacune desdites cellules. 

10 

2. Procede selon la revendication 1 , dans lequel la fusion est effectuee sur les 
valeurs des probabilites fournies par une plurality de radars, et notamment 
deux radars. 

15 3. Proc§de selon Tune quelconque des revendications 1 et 2 f dans lequel la 
fusion est effectuee sur la valeur de la probability fournie par un radar et la 
valeur de la probability anterieurement connue par la meme cellule. 

4. Proc6d6 selon Tune quelconque des revendications 1 a 3, dans lequel on 
20 deduit, des signaux re$us en echo, une information de distance et une 

information angulaire sur les obstacles, et on determine lesdites probabilites 
d'occupation a partir de ces informations. 

5. Procedy selon Tune quelconque des revendications 1 S 4, comprenant une 
25 etape de seuillage des r£sultats de la fusion. 

6. Proc£d£ selon Tune quelconque des revendications 1 £ 5, dans lequel le 
signal 6mis par les radars est moduli en frequence, le signal regu en 6cho est 
melange a une fraction du signal 6mis pour, apres §limination de la frequence 

30 porteuse, former un signal de battement, et la distance d'un obstacle est 
obtenue soit par transformation de Fourrier soit par comptage pendant un 
intervalle de temps pr6d6termin§. 

7. Proc6d6 selon I'une quelconque des revendications 1 a 6, dans lequel 
35 remission de chaque radar dure un temps limity, et la logique de repetition est 

cod<§e en vue de ('identification de la source. 
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8. Dispositif pour la detection et la localisation d'obstacles dans 
I'environnement d'un v6hicule, caracterise par le fait qu'il comprend une 
plurality de radars (2) months sur le vehicule et une unite de traitement (7) 

5 ag ncee pour fusionner les donnees fournies par les radars. 

9. Dispositif selon la revendication 8, dans lequel les radars sont a lobe large. 
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